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ABSTRACT 

Any effort to provide precision control for an Autonomous Underwater Vehicle 
requires an accurate estimation of both the vehicles physical and hydrodynamic 
parameters. Here a vehicle model for controlled steering behaviors was developed and 
the hydrodynamic parameters were calculated from actual data obtained from operation. 
The steering equation parameters are based on a least squares fit to sideslip and turn rate 
data using maximum likelihood of batch processing. In this way, a more accurate 
simulation has been found for the development of a track controller that stably drives the 
vehicle between mission waypoints. Prediction accuracy of the model was better than 


ninety-five percent over the data set used. 
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I. INTRODUCTION 


A. GENERAL BACKGROUND AND LITERATURE 

The increased desire to use Autonomous Underwater Vehicles (AUVs) and 
Unmanned Undersea Vehicles (UUVs) for commercial and military applications has led 
to a great deal of research in this field over the last decade. Specifically, the military 
need for clandestine mine reconnaissance is now being solved using AUVs. A high 
degree of maneuverability in shallow water conditions means these vehicles must have 
high performance steering controllers requiring accurate computer models. Although 
computer models have facilitated the estimation of fluid parameters on vehicles, the 
building of accurate models to match complex shapes is tedious and time consuming. An 
exact calculation of the dynamic parameters of an AUV is impossible. Even with an 
estimation of these parameters, there remains the question of validation of the results 
obtained. To get the hydrodynamic properties for marine vehicles generally one of the 


three following methods is normally used: 


1. Detailed computer modeling as previously mentioned; 


2. A tow tank. In a tow tank, generally a model (models of large vessels are 
used due to size restrictions) of the vehicle is pulled through the water and 
maneuvered while maintaining a constant speed. During this entire time, 
instruments are used to measure the forces acting on the vehicle. This process is 
very informative and provides very good results. But, it is very time consuming 
and expensive to accomplish; and 


3. By approximating the shape of the vehicle to known shapes and using this 
approximation to calculate some coefficients and using system identification 
methods for others. 





Apart from the calculation of the hydrodynamic masses, hydrodynamic 
coefficients, Yy, Y:, Ny, Nr, Ys and Ns are not easily computed, and when 


measured using 2, do not always match field data from 3. 


B. SCOPE OF THIS WORK 


The overall problem of marine vehicle hydrodynamics is very complex and 
diverse. This study will focus on the identification of the NPS ARIES AUV steering 
system hydrodynamic parameters. In particular the values of added mass for sway and 
yaw are determined from physical measurements, which are adapted to an approximate 
shape. Normal system identification techniques [Ljung et al.] obtain values for a 
canonical set of transfer function parameters for which Y,, Y,, N, and N, (defined in 
Chapter II) cannot be extracted uniquely. However, with turn rate (7), sideslip velocity 
(v), and rudder angle (6) measurements, it is possible to get a uniquely identifiable 
estimate of each parameter N,, N,, Y, and Y,. In this case, we use a set of data obtained 
from ARIES and use a least mean square batch regression process to obtain unique 


values. 


Previous literature on this subject includes a major work by Abkowitz, (1980) 


using a tanker. In which the estimated hydrodynamic coefficients were obtained using an 


extended Kalman Filter. The results were inconclusive however, because they did not 


match model test data and the ship had to be built in order to get test results. 


Chapter II discusses the equations of motion for an underwater vehicle and AUV 
modeling. Jt also includes the calculations, formulas and approximations used and the 


reasoning behind each. 





Chapter III discusses the theory of parameter identification from vehicle 


measurements and the methodology used in this report. 


Chapter IV provides information on the data collected by the ARIES AUV and 


the processing required to obtain the final results. 


Chapter V proves that the methodology used in this report provides an accurate 


way to obtain hydrodynamic coefficients from vehicle data. 


Chapter VI lists the conclusions of this report derived from Chapter V. 
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Ii. EQUATIONS OF MOTION AND AUV MODELING 


A. GENERALIZED STEERING EQUATIONS OF MOTION 





This section will discuss the equations of motion for a rigid body in an underwater 


environment leading to the model used for AUV steering control design and the 


simplifications made for the analysis of the NPS AUV. 


The forces acting on the AUV determine its motion and are independent of the 


inertial position. The equations of motion are given using Euler equations for the body 


fixed frame (Greenwood, 1980). The six simplified equations of motion given by 


(Healey, 1995) are: 


SURGE EQUATION OF MOTION 

m[ wu, -v,r+w,q-xg(g? +r? }+ yg (pq-F)+2¢ (pr +4) ] HW -B)sin0 =X, 
SWAY EQUATION OF MOTION 

ml, +u,r—w,p+x¢(pq+F)—yo(p? +r? }+ 26 (gr p)] (W - B)eos Osin b= ¥, 
HEAVE EQUATION OF MOTION 

het tniie tates, 
ROLL EQUATION OF MOTION 

1, p+(t, -1, lor +1 (pr -9)—Lyelg? -r? )- Le (pq + 7)+mlyg (-u, +9, p) 


—zo(b, +u,r -w,p)|- (yoW —y,B)cos@cosh+(z.W —z,B)cos Osin > = Ky 


(1) 


(2) 


(3) 


(4) 





PITCH EQUATION OF MOTION 
q+, —I,)pr-1,,(gr + p)+1,,(pq-r)+ 1,,(p? -r?)-mlxg(w-u,9+v, p) (3) 
-z,(u, -v,r+w,q)]|+(xgW —x, B)cos6cos$+(z,W —z5B)sin 0=M, 
YAW EQUATION OF MOTION 
1,7 +, ~1,)pq~ I (p? -q?)-1,,(pr+4)+ I. (gr - p)+mbxg(¥, +u,r-w,p) (6) 
—Vo (u, ~v,r+w,q)|-(xgW —xpgB)cos 0 sin o-(yoW — y,B)sin Q=N, 

The variables u, v and w are the component velocities expressed in terms of a 
body fixed coordinate system and the r subscript denotes that the velocity is with respect 
to the water. The variables p, g and r are the components of angular velocity expressed 
in the body fixed coordinate system. W and B are weight and buoyancy and I is a 
moment of inertia term. The x, y and z variables with the B and G subscript come from 
the position difference between the center of gravity, center of buoyancy and the center 


of the vehicle and the effects of gravity and buoyancy. All of the right hand terms are the 


forces acting on the AUV acting in the associated direction. 


Further simplifications can be made to Equations 1 thru 6 with the following 


assumptions for the AUV: 
1. That the vehicle is neutrally buoyant, B = G. 
2. Horizontal plane motion, [w, ,p,9¢,Z,@,0,xG.ycG] = 0. 


3. The forward speed u, is a constant Up. 








4. Surge motion changes are neglected. 
5. Roll coupling is neglected. 


These assumptions reduce the steering equations of motion to: 


u, =U, (7) 
mv, =-mU,r+ AY, (t) (8) 
I,,¢ = AN ,(t) (9) 

yer (10) 

X =U, cosy-v, siny+U,, (11) 

Y =U, siny-v, cosy+U,, (12) 


Now that the equations of motion have been reduced, the forces acting on the 
AUV must be addressed. Recognizing that under steady motion there 1s a balance 
between lift, drag, buoyancy, weight, and propulsion provides the starting po:nt to 
develop the components AY;,(t) and AN,(t). The variables AY,(t) and AN, (:) represent 
forces as a function of the vehicles dynamic parameters. Equation 13 assumes tha: all 
motion variables to be small compared to vehicle speed and the dimplies a ‘smal: change 


ae 


in’. 
OF = f(uy,V,,W,,p,9g,¥,au,/at, dv,/dt, w,/dt,dp/dp, dq/dt, dr/dt,t) (13) 


Simplifying Equation 13 is based on the following rational that the AUV is 


generally symmetric about its longitudinal axis and that fluid flow in one direction will 





not greatly affect an orthogonal direction. The expression for the transverse force 





becomes: 
Y,=Y¥,0,+Y, v,+¥,r+¥Y,r (14) 
and 
Y; all > Vy ale Y; male Y, ALD 
"Ov, " Ov, or or 


evaluated at the forward speed Uy. The coefficient Y, is the added mass in sway, 
evaluated with the vehicle in forward motion, Y;1s added mass induced by yaw, Y, isa 


coefficient of sway force from side slip, and Y, is a coefficient of sway force from yaw. 
The rudder when actuated will produce a lift force that when linearized is expressed as 


Y;5,(t). Likewise the rotational force is developed as: 











N,=N,v,+N,v,+N,F+N,r (15) 
and 
GN 
Ny, = St; N,, = St; n= St; w, =F; 
' OV, OV ar Or 


evaluated at the forward speed Uo. The coefficient NV, is the added mass moment of 
Inertia in sway, evaluated with the vehicle in forward motion, N,is added mass moment 
induced by yaw, N, is a coefficient of yaw moment from side slipping, and N, is a 
coefficient of sway moment from yaw. The rudder when actuated will produce a force 


that linearized, is N;5,(t). The equations of motion in the horizontal plane are given by: 


mv, =—mU yr +Y,, 0, +, ¥, + ¥,F +¥,r+¥55,(0) (16) 


8 





Ih = Ny v,+N,v,+N,F+N,r+N58,(t) (17) 


When the equations are cast into matrix form of Mx = Ax + Bu the result is 


mY, sy: 57 [¥% yv- 
" " fel oe me) tal | 5, (0) (18) 
Vg: I. -N; r tN N, r Ns 
In Equation 18 the term &,(r) is a generalized command that represents the control 


input to both rudders. It should be noted that while the rudders act together they turn in 
opposite directions. This tandem but opposite operation allows for rapid turning during 


operation. 


The final approximation made for the AUV was that the cross coupling terms in 
the mass matrix are zero. This approximation is based on the fact that the vehicle is 
symmetric and the rudders are very close to being equidistant from the body center. 


Therefore the final set of equations to be solved for steering behaviors are: 


ear v Le. xis 
iy miele _. a Plea &.() (19) 


The model is complete if values for the hydrodynamic coefficients can be found, 
and is appropriate for low angle of sideslip maneuvering in a longitudinal plane. 


B. AUV GEOMETRY, INERTIA PARAMETERS 


The usefulness of any model simulation is directly linked to the accuracy of the 
model being used. In theory an exact model will give an exact prediction of results for a 
particular simulation. However, in reality a perfect model, except in limited cases can 


never be achieved. The purpose of this section is to describe the NPS ARIES AUV, how 





it was modeled and discusses assumptions and approximations that were made to develop 
the final model used. 


A. AUV Model General Parameters 


The AIRES AUYV shown in Figure 1 is the vehicle being modeled in this work. 
The parameters required for analysis include weight, volume, moment of inertia and 
hydrodynamic added mass. To begin modeling the AUV the overall dimensions were 


measured. Measured dimensions obtained were as follows: 
1. Length from nose to end of tail section (not including thrusters) 128 inches. 
2. Width determined longitudinally at the center section 16 inches. 


. Height determined vertically at center section 10 inches. 


a) 


4. Weight was recorded on a lifting scale to be 490 Ibs. 





Figure 1 ARIES AUV 


The vehicle was then divided into three distinct sections for ana!vsis. The tall 


(1 
fo 
thi 
fo 


section was modeled as a triangular prism. The center section was modeiec 


rectangular prism. And finally, the nose section modeled as a half ellipsoid. 


10 





The assumption of symmetry for the AUV defines the body axes as the principal 
axis set for the vehicle. When evaluating the inertia matrix it then becomes diagonal (1.x, 


ly. Ly). 


pas AUV Tail Section Analysis 


The AIRES AUV tail section was modeled as a rectangular prism shown in 
Figure 1. The dimensions used were based on where the vehicle started to change shape 
at the stern. For this and all subsequent discussions of parameters the x-axis is defined as 
the longitudinal or lengthwise direction (length nose to tail). The y-axis is defined to be 
the athwartships or beam direction (width). Lastly, the z-axis represents the overall 
height of the vehicle in the vertical direction (height). The values measured for 


calculations involving the tail section are: 


a. Height 10 inches 
b. Width 16 inches 
c. Length 26 inches 


The calculation of volume was conducted by multiplying the area of the side face 
(SLength*Height) by the width. Hence the total volume of the tail section was 


determined to be 2080 in’. 


Li 











Figure 2 Tail Section Model 


The next step was to calculate the mass moment of inertia for the tail section. 
This required two steps. The first was to determine the moment of inertia for the section 
itself and the second was to translate the calculated moment to a selected reference point 
on the AUV. All moments of inertia were translated to the geometric center of the mid 
section. The moment of inertia for the tail section was not tabulated in Beer and Johnson 
(1997), Rothbart (1964) or any of numerous texts reviewed. The calculation was carried 
out using principals contained in Beer and Johnson (1997), these can also be found in 
most calculus textbooks, i.e. Finney and Thomas (1994). The solution for the moment of 


inertia in the x-direction was accomplished as follows: 


First a differential mass (dm) was chosen using a strip in the x-y plane. The 


origin was chosen to be on the forward face center. The differential equation of mass 


{ 
ipa he (20) 
a 
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was developed based on geometry. Performing the integration of both Sides yields the 


result. 
j 
m=9- abe Or m=pV (ai) 


where m is the mass, p 1s the density, a 6 and c are the dimensions, and V is the volume. 
For the elemental rectangular area in the y-z plane, Larea= = dm . Thus the 
differential mass moment of inertia is pt/ area where ¢ is the thickness of the 
differential mass. 
Then the total differential mass moment of inertia (dl, ) is, 
di. = ptl_area+x*dm. (22) 


Where the x’dm term translates the moment to the center a the AUV mid section 
using the parallel axis theorern as outlined in Beer and Johnson (1997). Integrating di. 
from x = 0 to 26 inches for pt/,area and x = 37.5 to 63.5 inches for the x’dm term and 
substituting M for pV, 
I = 2190.25*M. 


Similar calculations were preformed for 1. and I, using MAPLE software and 


are included in Appendix A. The resulting values are shown in Table 1. 


i 





Table 1 Mass Moment of Inertia for AUV Tail Section 
Axis | Mass Moment of Inertia! Units 


i 142.337M Ib*in* sec? 





2 


; 
? 
H 


Ib*in*sec 





3. AUV Mid Section Analysis 


The center section was treated as rectangular prism shown in Figure 3 whose 


dimensions are: 


a. Height 10 inches 
b. Width 16 inches 
c. Length 75 inches 





Figure 3 Mid Section Model 


The formulas describing the mass moment of Inertia for a rectangular prism as 


shown in Equations 23 thru 25 are readily available in many textbooks, 
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including Beer and Johnson (1997) and Finney and Thomas (1994). The derivation of 
the formulas is omitted and only the results are shown in Table 2 below. 


Table 2 Mass Moment of Inertia for Mid Sectio 
Axis | Mass Moment of Inertia Units | 


29.67*M Ib*in* sec’ | 


490.08*M Ib*in* sec” 
477.08*M Ib*in* sec” 


4. AUV Nose Section Analysis 





The moment of inertia calculation was carried out using the same methodology as 


the tail section. The model used for the nose shown in Figure 4 is that of a half ellipsoid. 


15 








Figure 4 AUV Nose Section Model 


First a differential mass (dm) was chosen using a strip in the y-z plane. The 


origin was chosen to be on the aft face center. The differential equation of mass 
x? 
dm = oa — (26) 
: 


was developed based on geometry of an ellipsoid. Performing the integration of both 


sides yields the result 

m=onabc OF m=pV 
where m is the mass, p is the density, a b and c are the radial dimensions, and V is the 
volume. For an elemental elliptical area in the y-z plane, J; area = ree Beer and 


Johnson (1997). Thus the differential mass moment of inertia 


a ae, _ (ae\ 2 3 
--» Mass = ptl area=p (4 (27) 
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where dx is the thickness of the differential mass. Then the total differential mass 


moment of inertia (dI,) 1s, 
dl... = ptl_,area+x*dm. (28) 


Where the x’dm term translates the moment of the nose to the center of the AUV 
mid section using the parallel axis theorem as outlined in Beer and Johnson (1997). 
Integrating d/,, from x = 0 to 27 inches for pil ,area and x = 37.5 to 63.5 inches for the 
x’dm term and substituting M for pV, 


LL, = 2316.43*M 


Similar calculations were preformed for I,, and ly using MAPLE software and 
are included in Appendix A. The resulting values are shown in Table 3 below. 


Table 3 Mass Moment of Inertia for AUV Nose Section 
Axis | Mass Moment of Inertia Units 


The value of density chosen for the AUV was based on its weight and 









displacement. To determine the displacement, a calculation was preformed to determine 
the volume of seawater for a weight equivalent to the AUV minus five pounds for 
buoyancy. Since the nose section had a free flood area the actual displacement of this 


section had to be estimated. To adjust the volume of the nose section a percent fill factor 
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was used to adjust the volume of the nose from a full volume to a displaced volume. 
Using a fill factor of forty percent resulted in a difference between calculated and 
estimated values of approximately one percent. A uniform density was then calculated 
by dividing the AUV weight by the calculated displaced volume. All calculations are 


listed in the MATLAB file auvcalc.m in Appendix B. 


Table 4 shows the total mass moments of inertia as a result of summing the value 
of all three sections. 


Table 4 Total Mass Moment of Inertia for the ARIES AUV 
Axis | Mass Moment of Inertia 


4457.18*M Ib*in*sec” 


C. AUV ADDED MASS PARAMETERS 









Units 





This section will discuss the method used to obtain the added mass coefficients 


N, and Y, of Equation (19). All of the actual calculations are contained in the MATLAB 


file auvcalc.m in Appendix B. Added mass is a concept that represents the inertial 
reaction on a moving body in a dense medium arising from the time rate of change of 
fluid momentum. While many textbooks, such as White, 1999 have tables for some 
general shapes they do not have tables for combinations of these shapes or complex 
shapes. Due to the complexity of the shape of the AUV, an approximation of the overall 
shape had to be made. Initially, an oblate ellipsoid was chosen since the ability to specify 
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all three axis dimensions was desired. The initial reference used was Lamb, 1945. While 
the general description of how to solve this type of problem was addressed, no closed 
form solution existed. A report by Tuckerman, 1926 discussed the inertia factors of 
ellipsoidal shaped airships. This report discusses the complexity of the calculations and 
the use of elliptic integrals to obtain a solution. It was then decided to make a more 
general simplification to the model. The ARIES AUV was modeled as a prolate 
ellipsoid. This simplification allowed the use of tables and closed form solutions found 


in Lamb, 1945 to calculate the added mass terms needed. 


The first step in calculating the added mass coefficients was to determine the 
neutrally buoyant mass. Total shape volume was calculated from the measured 
dimensions. The total weight was then equated to a volume of seawater. The purpose of 
this was to determine the difference of volumes since the nose is a free flood area. 
Results showed that a fill factor of forty percent was required to equate the two volumes. 
Since added mass calculations are based on displaced volume, the total volume was then 
equated to the prolate ellipsoid model. Requiring the volume to remain the same for the 
model, it was decided to maintain the overall length and let the equivalent diameter be 
calculated from the total volume. The calculated diameter along with the length was used 
in the eccentricity sleditions Formulas used also required the neutrally buoyant mass. 
The AUV was measured to have approximately five pounds of buoyancy. Therefore, five 
pounds was added to the measured weight to make the AUV neutrally buoyant for 


calculations. 


The last step in calculating the added mass terms needed was to determine J, The 
calculation of [,, was used in the formulas developed in the previous sections but with 
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minor modifications. Since the AUV has lateral and vertical thruster tubes (that were 
empty when data was obtained) and no mass moment of inertia, the effect of these tubes 
was subtracted based on axis of rotation for modeling purposes. Table 5 lists the mass 


moment of inertia values calculated using the MATLAB file auvcalc.m listed in Appendix 


B. 


Table 5 Final Mass Moments of Inertia for the ARIES AUV 


ee ee ae 
eae ee 


As a check of values calculated for the mass moment of inertia, the radii of 















gyration was calculated for all three axes and found to lie within the vehicle body at 
reasonable points. The calculations are shown in the MATLAB file auvcalc.m listed in 
Appendix B and the results are listed in Table 6 below. 


Table 6 Radii of Gyration for The ARIES AUV 


ee 
Distance (SJ) 18.60 73.20 73.56 
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Til. PARAMETER IDENTIFICATION FROM VEHICLE 
MEASUREMENTS 


A. INTRODUCTION AND BACKGROUND 


The uncertainty of forces affecting any underwater vehicle motion requires 
knowledge of the methodology of parameter identification. Basically, the problem is to 
identify the desired vehicle hydrodynamic parameters from a system model and 
measurements of other vehicle parameters. This topic is discussed in control technology 
Soderstrum and Ljung (1983), Kalman (1969), Gleb (1974) and has been developed 


especially for dealing with this problem. 


Essential to the parameter identification is an accurate model of the AUV control 
(input) and response (output). By manipulation of the equations of motion, we can let the 


system parameters become unknowns and the variables, as measured, to be known. 


B. GENERAL THEORY 


To model the AUV steering control, a model was selected with the input output 


response of the form 

y(t)= Ae pe)+ ve), (29) 
where y(t) is the primary output, H(z) is a matrix of measurements relating the input to 
output, and 6(¢) being a parameter vector which is ideally constant. The term v() is a 


zero mean gaussian white noise. 


Selecting a first order system as an example, and temporarily neglecting noise (avoiding 


differentiation problems) the model ts: 


x(t)= A(u(t)—x(¢)) with y(t)= cx(t). 
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Substituting and rewriting, the model becomes: 


ve )+ Ay(t ) = chu(t), or in matrix form 


=Exl) Wile?) 10)=Er6) ala of)=|* 


where y(t) is the derivative of the measured out put, B = cA and the independent parameters are 


B and A. 
The AUV measurement data obtained from sensors is sampled at eight Hertz and 
is therefore not continuous. Since the data is sampled at a discrete interval. a discrete 


time model must be used. The discrete time transfer function of the above model} js: 


ob, = 
G(z)= ¥(z) _ a . 
Ul) 1-Sa z? 
jel 


and in time difference form the equation becomes: 


Vp ~ AV j 4 — 221-2 — ++ = By yy + bQu,_2 +... OF Y, = ia Vicor astljces : (30) 


T 
so that He y459ooiestiasticoss| and O(t) = [ay a 5.-.5b,575---] . The first eguauon 
represents a matrix containing the system inputs and outputs and the second 1s ayain a © 


parameter vector. 


oe 





Cc, SOLUTIONS USING THE METHOD OF LEAST SQUARES 


The purpose of using a least squares method is to estimate the parameters 6(r), 


which are never exactly known, so that the difference between the actual parameter and 


its estimate are minimized. This difference is called equation error and is given by, 


et)=(o¢)- 26@)) (31) 


where 6(t) is the estimate of 6(t). For the AUV this involves using the data obtained 


from the vehicles sensors combined with the system model shown in Equation (19) to 


obtain the hydrodynamic parameters. To minimize the error, define the scalar positive 


squared error measure, J(n) = Se’(t)e(t) then the minimization of J is given by 
f=] 


<=0=-LH'¢() 


t=] 


and substituting from Equation (29) yields 


0=-FH'@¢)-AO KO) (32) 


t=] 


Rearranging Equation (30) to get the generalized equation 


EH @)= EH OHORE) G3) 


t=l 
Writing the equations in matrix form and solving for 6(t) gives 

6 = [H’H]'H'y (34) 

Using the matrix divide function in MATLAB to evaluate Equation (32) will give 


a result that is a least squares fit for 6(). 
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The same result may be found using guassian random assumptions in which the 


solution, 6 in Equation 33 is the most likely solution in which its probability is maximum 


Gelb (1974). It should be noted that the regression matrix, [ 54'(t)H(1)] must be positive 
t=] 


and strong (with no singularity) otherwise its inverse does not exist. This means that the 


system must be perpetually excited by its input. 
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IV. DATA ACQUISITION AND PROCESSING 


This chapter discusses the data collected by the ARIES AUV including the 
sensors. How the data is processed and the procedure used to obtain the hydrodynamic 
coefficients. 


A. AUV DATA ACQUISITION 


An onboard computer samples all the data obtained from the AUVs sensors at 
eight hertz. This data is maintained onboard until the AUV surfaces and transmits the 
data through an aerial link, or it is downloaded by use of an interface cable connected to 
the AUV after recovery. The parameters logged by the AUV are post processed using the 
MATLAB script file in Appendix 2. All the parameters logged are listed below by sensor 
and variable name assigned to it. Some key variables recorded at 8 Hz. are 


1. Pressure Cell 


a. Depth 


2. Gyro/Compass/Acoustic Doppler Log 


Heading 

Forward Velocity (Relative to ground as well as the water mass) 
Sideslip Velocity (Relative to ground as well as the water mass) 
Heave Velocity (Relative to ground as well as the water mass) 
Roll Angle 

Roll Rate 

Pitch Angle 

Pitch Rate 

Yaw Angle (Heading) from Magnetic Compass 

Yaw Rate 

Altitude above bottom 


ror gg tho AO oP 


3. Global Positioning Receiver (GPS) 


Position 
Heading 


oa 
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c. Speed 
d. Differential Correction Status (0/1) 


4, Onboard Computer (Outputs from Controllers) 


Rudder Position Ordered 
Plane Position Ordered 
c. Thruster Command Voltage 


or 


B. DATA EXTRACTION AND PROCESSING 


The raw data is post processed using MATLAB file assign38.m shown in 
Appendix B. The assign38.m file also produces a plot of vehicle position during the 
mission. Figure 5 shows the track of the ARIES AUV mission used in this report. For 
the analysis procedure used in this report, a set of continuously changing (dynamic) data 
was required. This data set represents a mission to track a set of waypoints forming a 
lawnmower pattern. On leg 3 an oscillating response produced data to identify the AUV 


parameters. 
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Path plot X,Y 
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Figure 5 MATLAB Plot of Full AUV Mission File d100600_04.d 


Figure 6 shows the subset of data seen in Figure 5 that is used in the 
determination hydrodynamic parameters. The limit cycling behavior arose from the use 
of an initial steering controller-not well behaved-but good for the purpose of steering 


parameter identification. Once this portion of the data was isolated for analysis it was 


analyzed for its usability. 
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Path plot X,Y 
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Figure 6 MATLAB Plot of AUV Mission File Portion Used In Analysis 


One of the limitations of the data was that the rudder signal was the command 
signal and not the actual position. The ARIES rudder motors are stepper motors run open 
loop. Figure 7 shows the recorded rudder command and yaw rate for the portion of the 
data being used. Looking closely at Figure 7, it can be seen that the change 1n \aw rate in 
response to rudder action was delayed. This delay is primarily the resul: of rudder 
response time. From the data shown in Figure 7 and observed response time. it was | 
decided to use a first order lag of 0.26 seconds for the rudder signal. Figure § shows one 
rudder cycle and a first order lag version of the command signal. A first order lag was 
used to more accurately describe the time history required for the rudder to change 
position in response to the command signal. To reduce bias in the data, all parameters 


28 





were converted to zero mean before being used for calculations. The data is now ready to 
be used to calculate the hydrodynamic parameters. The MATLAB file thesis _values.m in 
Appendix B was used to process the isolated data using mass matrix values calculated 


from Chapter II and Equation (19) developed in Chapter II. 


Rudder Command and Yaw Rate 
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Figure 7 MATLAB Plot of AUV Rudder Order Command and Recorded Yaw Rate Used 
For Analysis 
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Rudder Command Signa! 


—— Raw Signal i 
“+ Lagged Signal 


ed 
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Figure 8 MATLAB Plot of One Cycle Of AUV Rudder Order Command Original Data 
And Lagged Version Used For Analysis 
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Vv. RESULTS 


A. DISCUSSION OF RESULTS 


The first step in calculating was to put all of the variables into a set of consistent 
units. For this portion of the report all calculated and measured values were either 


verified or converted as required. 


Then using Equation 19 and the assumption that there is no cross coupling and 
therefore the off diagonal terms of the mass matrix are zero, two independent differential 


equations can be written as follows: 


(m-Y, ), =¥,,v,+(¥, -mU, y+ ¥55, (35) 
(7..-N;=Nyv,+N,r+N55, (36) 


where the notation as a function of time has been omitted for clarity. Rewriting Equation 
36 explicitly in terms of time and using IN =(/,,-N;), @=N,, 8 = N,, and y = Ng 
results in 


IN(t4) -%) 


7 = av,+ Br;+ V6; (37) 
Solving Equation 37 for r,,, yields the result 
a = eal + Bea, aS 1 (38) 
IN IN IN 


Now using the theory developed in Chapter III and relating Equation 38 to 


Equation 29 and 31 then, 


66)= [6.66.00], W)=r1,and HO=[,.7.58)] 
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aa 


where 6, =——, 9, = i +1 and 6, = a Casting these results in the form Equation 33, 


ae where H is a matrix and y is the vector 7,,,. Using MATLAB to perform the 


matrix operations gives a least squares fit for 6 as discussed in Chapter III. From the 


values calculated for @,, 6, and 6;, the values of a, 8 and y (N, , N,and N,) are readily 
determined. Similar analysis was done for Equation 34 to obtain the sway parameters. 


The MATLAB file thesis values.m calculated the hydrodynamic coefficients 


Y, ,¥,,Y¥s3,N5,N, andN,. The values obtained for these coefficients are summarized in 


Table 7. 


Table 7 Calculated 7 Steering Coefficients of the ARIES AUV 
68.16 406.30 Pats -10.89 -88.34 -35.47 


Once these coefficients had been calculated they needed to be evaluated for 






accuracy. The coefficients and model developed were combined and a simulation was 
conducted to compare with the data obtained. Figure 9 shows the original yaw rate plot 
with the plot predicted by the model. Figure 10 shows the original sway plot with the 
plot predicted by the model. It can be seen that in both plots the two are very close to 


being the same, thereby showing the calculated coefficients are accurate. 
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Figure 9 MATLAB Plot of Measured And Predicted Yaw Rate 


33 





Sideslip 
0.4 


greet 


Pee ek eer eee ee Clk Be eee eee eee eee? Peek eee eee ee eee: Ser eer rere er) 


He bg SEEEE SIMD 
eae oe eprerse Srr- 


dot ns. 


e « 
PRIA EE ER SEEESES SEES EE Peco eee. Se ee hee ees eco. Peete eee eee eeeee re © Pee eer e erases (err rere errr ec eeeeere, Serre eee errr ry 


wD 
Cc 
oO euascseteens, : 
a: 
L | - s: 
0) i ¢ 
VY) f *! 
bon = + 
rr, : ¢ 
® 4 « 
OY baPi soir Ri ecie sige meas csnehSiaase devia Pica Zeachnesein te kanpSusamesaweheheadpwndvenie sa Oman yeteiesh atau ayuianPersaeietees = 
® e 5 : 
= . 3 
. ed 
: e 
2. : 
— i * * 
— * 
0) ~. 3 
* . . 
x : + 
® ‘ + : : : 
br 3 a eS sttee rps eecewns ewe. Seer eres eee reer Serre rere ren) ster ess Mera eerteenee eerer? ter reer rere er ee ree 
— +: > ’ 
i) a 
tz } :  * 
Pv 4 * 
t heed > 
ca > 
it} 
: be : 
sD es Casts Risa auhe, decelee Mcaee cuore eae ieee rae Satie GR ae pe RAR 
* u * 


& . 
etree Berens nett sme ets tee eas pede tenes neeneen pena rr ee cere 





0 20 40 60 80 100 120 140 160 180 200 
Time in Seconds 


Figure 10 MATLAB Plot of Measured And Predicted Side Slip 


B. ERROR MEASURES 


The scalar positive squared error measure J(n) (discussed in Chapter III C) for 
the coefficients obtained was 6.2055 x 10° for sway and 5.3467 x 10° for yaw rate. 
While this is a small number, the question remains, how does this compare to the data in 


a magnitude sense. To determine the relative error, the mean square error 
12, 
J(n) = — delle elt) 
N f=] 


was divided by the square of the data’s standard deviation Oy’. Taking the square root of 


this to get the relative error, 
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x 100% 


results in a relative error of 4.38 and 1.79 percent in sway and yaw rate respectively. 


Thus, the maximum error overall was less than 5 percent. 
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VI. CONCLUSIONS 


ws, 


The overall problem of underwater vehicle modeling is very complex. To obtain 
an accurate hydrodynamic model for any vehicle that is not a standard shape by purely 
analytical means is extremely difficult at best. The use of other methods such as use of 
model testing in tow tanks requires additional time, travel and expense and do not 
guarantee accurate results. Thus, the method used in this report has many positive 
features. The utility of this approach is to improve autopilot control design by using 
engineering approximations to the model of a vehicle. The data collected by the AUV 
can then be used to determine realistic estimates of the hydrodynamic parameters. An 
increased knowledge of hydrodynamic parameters then leads to a better control system 


design and performance. 


While this approach requires that an initial steering controller be designed 
successfully so that the input-output data may be acquired, the results of this study has 
led to the design of an improved controller for which the limit cycling shown here is not 


present. 
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APPENDIX A. MAPLE FILES FOR ARIES MASS MOMENT OF 
INERTIA CALCULATIONS 


This appendix contains MAPLE files for the calculation of the mass moment of 


inertias for the ARIES AUV nose, mid and tail sections respectively. 
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nose.mws 


% Worksheet to calculate AUV nose section mass moment of inertia. 
Calculate Ixx 


> restart; Nose section equations 
>L:=37.5+Y: Length from center of midsection to tip of nose section 
>A:=27: Length along x-axis 

>B:=8: Length along y-axis 

>C:=5: Length along z-axis 

> dm: =pi*rho*A*C* (1-Y¥%*2/B%2) : Differential mass 

> x:=A* (1-Y*2/B*2) “0.5: Equation of ellipsoid 
>z:=C* (1-Y*2/B%2)*0.5: 

>m:=int(dm,Y=0..B ): Calculate mass of section 
> IAA: =pi/4*z*x*3*dy: IAA' for area slice 
> dIAAm:=rho*IAA: Thickness = dy 

> dIx:=dIAAm/dy+Y*2*dm: Calculate Ix 

> dIxa:=dIx*M/m: M = m so answer is in form M*Ixx 
> Ix:=int (dIxa,Y=0. .B): 
> simplify (Ix) ; Ixx 

158.6000000 4 

Calculate Iyy 
> restart; 
>A:=27: 
>B:=8: 
>L:=37.5+Y: 
—Ct=5: 
> dm:=pi*rho*A*C* (1-Y¥*%2/B%2) : Differential mass 
> x:=A* (1-Y¥*2/B%2) “0.5: Equation of ellipsoid 

> z:=C* (1-Y*%2/B%2)°0.5: 

>m:=int(dm,Y=0..B ): Mass 

> IAA: =pi/4*z*x*3%*dy: [AA' area for area slice 

> @IAAm:=rho*IAA: Thickness = dy 


> dIY :=dIAAm/dy+L*2*dm: 

> dALYa:=dIY*M/m: 

> I¥:=int (dIYa,Y=0..B): 

> simplify (IY) ; lyy 
1789.850000 WM 
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Calculate Izz 


> restart; 


>A:=27: 

>L:=37.5+x: 

>B:=5: 

>C:=8: 

> dm:=pi*rho*B*C* (1-x*2/A%2) : Differential mass 

> y:=B* (1-x*2/A*%2)%*0.5: Equation of ellipsoid 
> z:=C* (1-x*2/A%2)%0.5: 

>m:=int(dm,x=0..A): Mass 

> IAA: =pi/4*z*y*3*dx: JAA! area 

> €AIAAm:=rho*TIAA: Thickness = dx 


> @AIZ:=dTAAm/dx+L*2*dm: 
> dIZa:=diIZ*M/m: 


> int (dIZa,x=0. .A) ; [zz 
) 2316.425000 4 


> 


4] 














midsection.mws 
% Worksheet to calculate AUV mid section mass moment of inertia. 


>restart; 


>A:=75: Length along x-axis 
>B:=16: Length along y-axis 
>C:=10: Length along z-axis 
> Ixnx=1/12*M* (B*24+C%2) ; 
89 
Ikx = 3M 

> Iyy=1/12*M* (C*2+A%2) ; 

eee 5/25 

aD 
> Izz=1/12*M* (A*2+B%2) ; 

Izz= M 
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tail.mws 


% Worksheet used to calculate AUV tail section mass moments of inertia. 


> restart; Tail Section Equations 
> 
> 
> 
>a:=26: , Length along x-axis 
>b:=16: Length along y-axis 
>e:=10: Length along z-axis 
> L:=x+37.5: Length from center of midsection to face 
of tail section 
> dm:=rho*c* (-b/a*x+b) : Elemental mass 
> m= { dm dx Calculate mass of section 
0 
1 b* dm 
> = a Calculate Iz 


Mass*I 


> diz:=Iz_ +L? dm 
> iz =| diz dx 
0 





> 
> simplify (Iz): 
Iz M | 
> Mz = use M=m to get result in terms of 
> simplify( Miz) | Iz result 
2190.250000 
>Iy. :=1/12*c*2*dm: 
> dy :=Iy_+L* dm Calculate Iy 
>h= { dly dx 
0 
> My = 2" 
m 
> simplify( My ) ly result 
2177.250000 M 
ee | (b> +c?) dm 
> fhe : ———S 
> dk =Ik_+ x* dm Calculate Ix 
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> Ix =| dlx dx 
0 


> Mi := oe 
m 


> 
> simplify( Mix) 





427 
a 
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Ix result 











APPENDIX B. MATLAB FILES FOR DATA ANALYSIS 
This appendix contains the MATLAB script file for analyzing data acquired form 


the ARIES AUV. The first file assign38 converts data stored in the AUVs computer to a 
matrix form with variable handles. The second file auvcalc.m determines the mass 
matrix coefficients, converts units from English to SI, checks radius of gyration and 
incorporates modeling approximations. The file thesis valuesm evaluates a 
predetermined portion of the data set and determines the hydrodynamic parameters based 


on values from auvcalc.m. 
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assign38.m 


clear all 
ele 


load 4100600 04.4; 


d=d100600 04; 


state: id = One ide 


Nav_Id = OS 2 )3 
Month = d(:,3); 
Day = A(:,4);7 
Year = (45) 3 
Hour = d(:,6); 
Minute = 655.713 
Second = d(:,8); 
t = OCs, 9)4 
x = d(:,10); 
x ai © fa erga at 
Depth = d(:,12); 
Alt = O15 ;13)7 
phi = d(:,14); 
theta = d(:,15); 
psi = Cs 6) + 
u = OCS, 773 
Vv me Os Oy 


Depth _dot = d(:,19); 


Alt dot = d{:,20); 
p = Ol tee) 
q = d(:,22); 
ig = d(:,23); 
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Bias psi = d(:,24); 


Bias r = d(:,25); 
Dutt = d(%,26):% 
NSv = d(:,27); 
LatDeg = OC 720) 
LongDeg = d(:,29); 
Ttle = d(:,30); 
nls = d(:,31); 
n rs = d(:,32); 
n_bvt = d(:,33); 
n svt = d(:,34); 
n blt = d(:,35); 
n_ slit = d(:,36); 
delta r = d(:,37); 


delta sp = d(:,38); 


Qy=0.5 3 Y1=1¥ (1) sdy 1491) -dx=(=19-x(1)) 7 length ( (v1) +23 
Al=[X(1) :dx:X(1)+ (Length (Y1)-1) *dx]; 


Y2=[491:0.5:691] ;X2=-19*ones (length (Y2)); 


PLoure (1)36CLt pplou(y, xX; be} Xs ee p22 re Arid, Zoom, axis 
equal; 


title(' Path plot X,Y, blue, Desired Path in red'); 


figure(2), plot(t,delta _r,t,r,'r.'),grid, zoom 
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analysis of model 


rhat=r; 


K=-0.1256; 


lamda= 0.2363; 


for i=l: (length(t)-1), 


rhat (1+1)=rhat(i)+0.125* (-Lamda*rhat (i)+K*deita r(1)); 


end; 


figure (3), eli, plot (tyr, (be ,t, thats 1." el pH—deltaxtid 2p Ks." grid 


figure(4),clf, plot(t,atan2(v,u}) 
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auvcale.m 


$calculate volume of AUV 

$ all measurements calculated in inches 
format compact 

format short g 


clic 

total wt=490/32.17/12; $ convert wt to mass 
CLD: So 2 oes) 

sw_denisty=64/32.17/12%4; Sib s*2 itn =4) 
Msw_denisty=1025; skg/m*3 


batt_wt=23/32.17/12; batt_num=6; batt_vol=6*6*10; 

$ tail section 

t vert=10; 

t_lat=16; 

t _long=26; 

t_vol=1/2*t _vert*t hac € Long % 2080 in*3 


$ Thruster Vol (negative) 

neg vol=2*pi/4710*5°2+2*pi/4*16*s"2; $ 1021.02 in%*3 
neg voly=2*pi/4*16*5%2; 

neg volz=2*pi/4*10*5%2; 


%$ center section 
©-vert=10; -al=Zz/.5; a2=30.57 bisl7.57 Db2=20.5; 


c lat=16; 

c_long=75; 

c vol _total=c_vert*c_lat*c_ long $12000 in%*3 
c _vol= c _vert*c_ lat*c_ _iong-neg_vol 10979 an*3 
e _voly=c_ vert*c_ lat*c. Llong-neg voly SLL37 2: TNS 
c volz= c¢ vert*c lat*c long- neg volz $11607 in*3 


*% nose section 
fillfactor=0. 4; 
n vert=10/2; n_lat=16/2; n_long=27/2; 


m_Vol= /5"4/3*pi*n: vert*™n.lat*n Jong*filitactor $ 452.4 in*3 
% total 
full vol=c_vol_ total+n_vol/fillfactor+t. vol 315211 
total _vol= t _volte _vol+n_vol : S Looli ans 
calc vol= (total. wt+5/32. 17/12) /sw _denisty $ 13365 51ib estimated 
bouyancy 
vol _error=(total vol-calc_vol) /total_vol*100 
homo _density=total_ wt/total vol $ 9.4e-5 lb s%*2 
in*=4 
density w_o battery=(total wt-batt _wt*batt _num). 
/(total_vol-batt vol); 8 


moment of inertia about center of mid section UNIFORM 


c Ix=89/3*homo density*c_vol_total-. 

1/12*homo_density* (3*2. 5°2+10% Diag 

1/12*homo_density* (3*2.5%*2+16%2) $33 
¢ Iy=5725/12*homo density*c vol total... 
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~(l/l2*homo densi ty*(3*2.5°2510°7) homo density bi" 2) sus BIBS 
=(1/i2*nomo. density” (3*2.0°2F10%2) +homo: density*b272) 5s 
-(1/2*homo_density*2.5*2+homo density*al%2)... 

~(1/2*homo: density™2.5°2thome density*a2°2) 


c Iz 5881/12*homo _density*c_vol_ total. 


$952 


~(1/2*homo density*2.5% 2+homo density*bi’ J ae 
-(1/2*homo_density*2.5*2+thomo_density*b2%2). 
-(1/12*homo density* (3*2.5*2+16"2) thomo_density*al*2) ... 
=(1/l2*homo. density” (3*2.5°2F16°2) +homo density*aZ°2Z) 


Smoment of inertia of nose about center of mid section UNIFORM 


n Ix=158.6*homo_density*n_vol 
n _Iy=1789. 85*homo_density*n_vol 
n_ Iz=2316.425*homo_density*n_vol 


$7 
$76 
$98 


Smoment of inertia of tail about center of mid section UNIFORM 


t_Ix= 427/3*homo_density*t_vol 
t_ Ty= 2177.25*homo_density*t_vol 
t_Iz= 2190*homo_density*t_vol 


328 
$425 
$427 


Stotal moment of inertia about center of mid section UNIFORM 


Ix total=t_Ixtc Ixtn_Ix 
iy total=t lyre tytn. ly 
Iz. total=t Izte iztn..2Z 


check values of Ixx, Iyy & Izz 
armx=sqrt (Ix_total/total_wt) 


army=sqrt (Iy_total/total_wt) 
armz=sqrt (Iz_total/total_wt) 


$convert quantities to metric units 


Mtotal wt=490*0.4536 

MIxx=Ix_ total*0.0254*.4536*9.81 
MIyy=Iy_total*0.0254*.4536*9.81 
Mizz=1z. total*0.0254*.4536*9.91 
Mvol total= FUE VoL 02945 

ckx= sqrt (MIxx/Mtotal | wt) *100/2.54 
cky=sqrt (MIlyy/Mtotal_wt)*100/2.54 
ckz=sqrt (MIzz/Mtotal_ wt)*100/2.54 


$added mass calculations 
L=64; W=8; H=5; 
secen=1-(( (W+H)/2)/L )%2 
ecen=1-=(( 7.53/L. )*2) 


alpha=2* (l-ecen%2) /ecen*3* (1/2*1log ( 
beta=1/ecen*2-(l-ecen*2) /2/ecen*3*1log ( 


kx=alpha/ (2-alpha) 
ky=beta/ (2-beta) 


kr=ecen*4* (beta-alpha)/( (2-ecen%*2)* 


e206 76391 

B div_g=Mvol total*Msw_denisty 
22089 

Xudot=-kx*B div_g 

Yvdot=-ky*B div_g 
Nrdot=-kr*MIzz 


S68 1 oe hae ae ota 
$1039 
$1078 


S1eoe 1h 
$28.62 
ae ems, 


$222.26 ko wt of auv 
$7.6849 ko m*2 

$117.4 

$121.9 

$0.24926 m*3 

$check of conversion 7.32 
$28.62 

$29.16 


inches 
$0.98 ave dia 
S$const vol const L 0.98616 


(i+ecen) / (i-ecen) ) -ecen) 0.08583 
(1l+ecen) /(1l-ecen) ) $0.95709 
$0.044€39 
0.9177 


(2*ecen*2~-(2-ecen*2) * (beta-alpha) ) ) 


$kg mass of water vol moved 


$kg -11.456 
Skg -234.47 
akg m2 "93.15 














Zwaot=Yvdot; 
Mqdot=Nrdot; 
Mmass=Mtotal wt 
MY=Mmass-Yvdot 
IN=MIzz-Nrdot 


51 


$222.26 
$456.73 
$215.04 


kg wt of auv 





thesis _values.m 


clear all 

Cle? 

format compact 

load osciilation.mat; 
$d=osciilation; 


State Id = d(:,1); Nav_Id = d(¢,;2)3 Month =a (+,3)% 

Day = d(:,4); Year S45) 3 “Hour = d(t; 6); 

Minute = d(:,/); Second = Ot. 6) e = d(:,9); 

Xx = AO ge Oy a oe = d(:,1l1); Depth = Cl 12) 3 
Alt tre ES )- 2° = d(:,14); theta a & fs Oran ls 
psi = d(:,16); u =O 6s,.17) 3 v7 = d(:,18); 
Depth dot = d(:,19); Alt dot a(s720)3> > = d(:,21); 
g = Oi 922) 5 x = d(:,23); Bias psi = d(:,24); 
Blas x = d(:,25); Diff = d(:,26); NSv = OCe 2 1) 
LatDeg = d(:,28); LongDeg St 29) s Tele =. 2.03 ;.50):3 
nls = d(:,31); n_rs = ON2 7 32)¢ RopVe = dCi, 53)4 
n_ svt = d(:,34); n_blit = (739) 7 N.Sit aCe 4.36)'3 
delta r = d(i;37)7 delta_sp =.d(2;38)+ 


$dy=0.5;Y1=[Y(1):dy:491]; dx=(-19-X(1))/length( (Y1)+1); 

$X1=(X% (1) :dx:X(1)+ (length (Y1)-1) *dx]; 

$Y2=[491:0.5:691] ;X2=-19*ones (length(Y2)); 

St Cure (1), Cli -pLotiy, X) ty "bey Yi, sl, ea pte, Ae; Ea iy Gels, ZOOMm,. axis 
equal; 

Stitle(' Path plot X,Y, blue, Desired Path in red'); 


%$ figure(2),plot (Y¥(2000:5000,1) ,X(2000:5000,1) ) 
$figure(2), plot(t,delta_r,t,r,'r.'),grid, zoom 


Sanalysis of model 


$rhat=xr; 
K=-4; 
lamda= 234; 


$for i=l: (length(t)-1), 
$ rhat(it+1)=rhat (i) *lamdat+K*delta_r(i); 
$end; 


$clf, plot(t,atan2(v,u) ) 


MY=456.73 
IN=215.04 


rdr=delta_r*pi/180; 
rdr=rdr-mean(rdr); 
Rr=r*pi/180; 
Rr=Rr-mean (Rr) ; 
Vv=v-mean (v) ; 


SEIEEEESEISSESSSEESSESEEESSESESESSE Lag rudder 


a2 





y(l)=rdr (1); 
n=max (size(rdr)); 
p=0.26; 

q=0.26; 

for i=2:n 





Vil) (lp) *y (f=) +q*rdr(i-1); 


end 
yrdr=y'; 


ESSSSEESSSESEEESSESESEITESESESESS 
$$Sadjust v from nose to center 


Lnose2center=55*2.54/100; 
Mid Vv=Vv-Lnose2zcenter*Rr; 


S$33S3ESS3S%3%% cala theatas%% 
Hl=(Mid Vv(1:1500,:),Rr(i: 
Y1l=[Mid_V ViZ22s 150 Ls. SiG 

thetal=inv (Al *Hl) said 


$mid point length converted to meters 


1500, :),yrdr (1:1500,:)]; 


H2Z=(Rr 1 1500;2),vrdril21300,5)-15 


Y¥2Z=(Rr(2:1501,%3) ) 7 
theta2=inv (H2'*H2) *H2'*Y2 


SEESESSESESSGS SES VESTS SUES SS SS SSSSSSEEEBSB 


rr=[];rr(1)=Rr(1); 
for i=1:1500, rr(itl)=rr( 


1)+0.125* (-67.9/IN*rr (i) -32.4/IN*yrdr (i) ) 


SSSESSSESSEESSSCalC paramenters 


% 

Yv=(thetal(1)-1) *8*MY % 

Yr=thetal (2) *8*MY & 

Yd=thetal (3) *8*MY % 

$Nv=theta2 (1) *IN*8 % 
Nr=(theta2(1i)-1)*IN*8 % 

d=theta2 (2) *IN*8 % 

$check MX 

det (H1'*H1) $4507 

cond (H1'*H1) $422.36 

$M=[IN]; 

SA=[Yr]; 

SMMM=M*%-1*A 

$eig (MMM) $[0.12268;6.9742] 
SESSSSSSBSScheck error 

erroril=Y1-Hl*thetal; 

J1l=1/max (size(H1))* (errorl'*errorl1) $6.22e-5 
error2=Y2-H2*theta2; 

J2=1/max (size (H2))*(error2'*error2) $5.41le-6 
figure (2) 

subplot (311) 

PlLOU-( tC, Rr; ct; yrar;’s:") 

Xlabel('v ... corrected for position') 


subplot (312) 
DLOE (E132) 
xlabel ('yaw rate') 


= 


-end; 





subplot (313) 
DILOE(eLrrord, rs.) 
xlabel('error') 


figure (3),plot (phi) 
SCL ly pLOUC (ty yy (be ytpr net, 2s yeyodelta 2.72) Ks 7G 
$figure(4), plot (Depth) 


phidot=phi; 
for i=2:1500 

phidot (1)=(phi (itl) -phi (i-1))*4; 
end 


figure (6) 

subplot (312) 

oy Rey ee Gieire a attain corgern Gre 8 Grae) © ame 
subplot (311) 

plot (errorl) 

subplot (313) 

plotlr, °r"} 
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